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Abstract 


NASA Johnson Space Center (JSC) is developing a low-volume, low-mass, robotic free- 
flying camera known as Mini-AERCam (Autonomous Extra-vehicular Robotic Camera) 
to assist the International Space Station (ISS) operations. Mini-AERCam is designed to 
provide astronauts and ground control real-time video for camera views of ISS. The 
system will assist ISS crewmembers and ground personnel to monitor ongoing operations 
and perform visual inspections of exterior ISS components without requiring 
extravehicular activity (EAV). 

Mini-AERCam consists of a great number of subsystems. Many institutions and 
companies have been involved in the R&D for this project. A Mini-AERCam ground 
control system has been studied at Texas A&M University [3]. The path planning and 
control algorithms that direct the motions of Mini-AERCam have been developed 
through the joint effort of Carnegie Mellon University and the Texas Robotics and 
Automation Center [5]. NASA JSC has designed a layered control architecture that 
integrates all functions of Mini-AERCam [8]. The research described in this report is part 
of a larger effort focused on the communication and tracking subsystem that is designed 
to perform three major tasks: 

1. To transmit commands from ISS to Mini-AERCam for control of robotic camera 
motions (downlink); 

2. To transmit real-time video from Mini-AERCam to ISS for inspections (uplink); 

3. To track the position of Mini-AERCam for precise motion control. 

The ISS propagation environment is unique due to the nature of the ISS structure and 
multiple RF interference sources [9]. The ISS is composed of various truss segments, 
solar panels, thermal radiator panels, and modules for laboratories and crew 
accommodations. A tracking system supplemental to GPS is desirable both to improve 
accuracy and to eliminate the structural blockage due to the close proximity of the ISS 
which could at times limit the number of GPS satellites accessible to the Mini-AERCam. 
Ideally, the tracking system will be a passive component of the communication system 
which will need to operate in a time-varying multipath environment created as the robot 
camera moves over the ISS structure. In addition, due to many interference sources 
located on the ISS, SSO, LEO satellites and ground-based transmitters, selecting a 
frequency for the ISS and Mini-AERCam link which will coexist with all interferers 
poses a major design challenge. To meet all of these challenges, ultrawideband (UWB) 
radio technology is being studied for use in the Mini-AERCam communication and 
tracking subsystem. The research described in this report is focused on design and 
evaluation of passive tracking system algorithms based on UWB radio transmissions 
from mini-AERCam. 
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Introduction 


UWB Technology 

Ultrawideband radio, in particular impulse or carrier-free radio technology, is one 
promising new technology for low-power communications and tracking systems. It has 
been utilized for decades by the military and law enforcement agencies for fine-resolution 
ranging, covert communications and ground-penetrating radar applications. In February 
2002, the Federal Communications Commission (FCC) approved the deployment of this 
technology in the commercial sector under Part 15 of its regulations [6]. UWB 
technology holds great potential to provide significant benefits in many applications such 
as precise positioning, short-range multimedia services and high-speed mobile wireless 
communications. 

The DARPA study panel that coined the term ultrawideband in the 1990s defines it as a 
system with a fractional bandwidth greater than 25%. The basic concept of current UWB 
impulse radio technology is to transmit and receive an extremely short duration burst of 
RF energy - typically a few tens of picoseconds to a few nanoseconds in duration. 
Whereas conventional continuous-wave radio systems operate within a relatively narrow 
bandwidth, UWB operates across a wide range of frequency spectrum (a few GHz) by 
transmitting a series of low-power impulsive signals. 

For the emerging technology of UWB radar and UWB wireless communications, the 
transmitted signal can be regarded as a uniform train of UWB pulses represented as 

4-co 

5 ( 0 - Y ®(t~nT r ), 

n =- oo 

where T r is the pulse repetition interval, and co(0 is the pulse-shaping waveform which 
is often a Gaussian monocycle. In the time domain, the Gaussian monocycle is 
mathematically similar to the first derivative of Gaussian function. It has the form 

co(0 = , 

t 

where x is regarded as the duration of the monocycle. Figure 1 shows an ideal monocycle 
centered at 2 GHz in both the time and frequency domains [1]. 
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Figure 1. Gaussian monocycle in time and frequency domains 
UWB impulse radio is characterized by several uniquely attractive features: 

• Low-power, carrier-free, ultra-wide bandwidth signal transmissions 

• Minimal interference on other RF systems due to extremely low power spectral 
density 

• Immunity to interference from narrow-band RF systems due to extremely large 
bandwidth 

• Immunity to multipath fading due to ample multipath diversity (RAKE receiver) 

• Capable of precise positioning due to fine time resolution 

• Capable of high data rate, multi-channel performance due to extremely large 
bandwidth 

• Low-complexity, low-power baseband transceivers without intermediate 
frequency stage 

Rapid technological advances have enabled the implementation of cost-effective UWB 
radar, communication, and tracking systems. Furthermore, antenna-array beamforming 
and space-time processing techniques promise further advancement in the capability of 
UWB technology to achieve long-range coverage, high capacity, and interference-free 
quality of reception [7]. 

Tracking Algorithm 

To make Mini-AERCam coordinated maneuvers feasible, an accurate, robust, and self- 
contained tracking system that is small, low power, and low cost is required. Compared 
to GPS receivers, which can offer range resolution on the order of one meter, UWB radio 
can achieve sub-centimeter range resolution much faster and with less effort [1], The 
experiment described in [2] demonstrates that UWB systems can provide range 
measurements accurate to the centimeter level over distances of kilometers, using only 
milliwatts of power from an omni-directional transceiver no bigger than a pager. In this 
research effort, the tracking subsystem will be designed to provide the precise positioning 
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required for Mini-AERCam motion control as a byproduct of the UWB video 
communication system. 

Many technologies have been applied to locating the source of radio signals, such as 
angle of arrival (AOA), time difference of arrival (TDOA) and relative signal strength 
(RSS). The extremely high fidelity of the UWB timing circuitry permits very precise 
measurement of propagation times for transmitted signals. This fine time resolution 
feature of UWB motivates us to apply a TDOA approach for tracking system design. We 
will utilize the header of the video data packets as the pilot signal to implement a passive 
tracking system in which the tracking rides on top of video communications [10]. 

Since electromagnetic waves travel with constant velocity in free space, the distance 
between the transmitter and the receiver is directly proportional to the propagation time. 
The TDOA approach determines the possible position of the transmitter by examining the 
difference in time at which the same signal arrives at multiple receivers. Each TDOA 
measurement determines a hyperboloid corresponding to the surface of constant range 
difference between the two receivers. At least three receivers are needed for a 2-D 
location estimate and four receivers for a 3-D location estimation. The intersection of the 
hyperboloids corresponding to all the TDOA measurements provides the location of the 
transmitter. 

Suppose N receivers measure the time of arrival (TOA) of pilot signals from the 
transmitter in a 2-D case. The TOA estimates of the signal from receiver i and j are 
denoted t { and tj respectively. A range difference measurement r k can be calculated 

from the TDOA measurement as follows: 

r k = c(t i -tj) = d i -d j =f k (x,y), (1) 

where d t and dj are the distances from the transmitter to receivers i and j, respectively, 

and c is the propagation velocity of the signals, which is generally taken to be the speed 
of light in free space. Since the positions of all the receivers are known, this equation is a 
function f k (x,y ) only of the unknown coordinate position of the transmitter (x,y) . 

In many cases, the transmitter location is determined by finding a least-squares solution 
to a linearized version of Equation (1) . The linearization is given by 

= fk( x o>yo ) + —(* - x o) + fiy - To) > 

ox dy 

where the partial derivatives are evaluated at the a priori estimate for the transmitter 
position (x 0 ,y 0 ). This estimate is normally a previous solution for the transmitter 
position. The linearized version of Equation (1) can then be expressed as a matrix 
equation of the form Ap r = b , where 
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A = 


dx dy 

M M 

dfK^K_ 
dx dy 

The least squares solution to this matrix equation is the estimated position of the 
transmitter, which is given by 

p r =(A r A) -1 A r b. 

The variance of the position estimate is related to the variance of the time estimate. 
Tracking requires that the direct path portion of the UWB signal be located and its arrival 
time inserted into the tracking algorithm. Hence, the accuracy of the TDOA estimates is 
very critical for position tracking. The conventional approach to estimating TDOA is to 
compute the cross-correlation of an identical transmitted signal arriving at different 
receivers. The TDOA estimate for each pair of receivers is given by the delay that 
maximizes the cross-correlation function. To complete the tracking algorithm, the 
sequence of position estimates is passed to a Kalman filter to update the current estimate 
of position. 
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Discussion of Results 

The results of the research completed by the PI during the 2004 NASA Faculty 
Fellowship Program are discussed in the remainder of this report. The discussion is 
divided into two sections. The first presents a careful analysis of the statistical properties 
of a particular TDOA localization algorithm currently identified for use in the mini- 
AERCam communication and tracking subsystem. The second presents a proposed 
modification to this algorithm that should improve the localization accuracy. 

Analysis of Current Algorithm 

The TDOA localization algorithm currently proposed for use in the mini-AERCam 
communication and tracking subsystem was developed and analyzed by Chan and Ho in 
[4]. The statistical properties of the algorithm are analyzed to some extent in [4], and 
while the analysis presented there is essentially correct, it is also sketchy and incomplete, 
making a thorough performance evaluation of the algorithm problematic. To correct this 
deficiency, the PI performed a careful and complete analysis of the statistical properties 
of this algorithm in two dimensions. The results of that analysis are discussed in this 
section. 

Assume that there is one transmitter located at an unknown location (xo^To) i n two- 
dimensional space and M + 1 receivers located at positions 
{(0 , °)» (e-Ti ), (* i >T 2 )> k > (x M ,y M )}, which are assumed to be known precisely. 
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Further, assume that measurements of the relative time delays \d\,d 2 , K ,d M } between 
the arrival of the transmitted signal at receiver (0,0) and each of the other locations 
(x\,y \ )’K ,(xft {,y}d) are available. If the propagation velocity of the signals is given by 

the constant c, then it can be shown that the following system of linear equations is 
satisfied: 


G 0 u 0 - h 0 , (2) 

where, 
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If the time delay measurements are not precisely correct, we have instead the system 

G 1 u 0 = h 1 -(Ah 1 -AG 1 u 0 ), (3) 

where 

c 2 8? + 2c 2 rf 1 5 1 

c 2 8 2 + 2c 2 d 2 5 2 

M 

c2 8 2 m + 2c 2 d M h M 


G, =G 0 + AG], h t = h 0 + Ah b AGj = -2 
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0 

cSj 
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, Ah] - 
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and 8 = [5] 5 2 L ] 7 represents the vector of errors in the relative time delay 

measurements, which is assumed to be a zero-mean Gaussian random vector with 
covariance matrix Q = E ^8 r j. For future reference, it is worthwhile to note that Ah] 
can be rewritten as 


Ah] = 2cR8 + c 2 8 o5 , 

where R = diag(q,r 2 ,K ,%), r t -cd t , for i - 1, 2,K , Af , and 

8 08 = |^8 2 S 2 L § 2 m J represents the Hadamard product of the vector 8 with itself. 

The estimate (x,y) of (x 0 ,y 0 ) is computed recursively in three stages. In stage 1, a 

weighted least squares approach is used to find an estimate of u 0 = [jc 0 y 0 r 0 ] 7 , 
which is given by 


2-7 



Ul=(GfW,G 1 )" 1 GfW,ll 1 , (4) 

where the weighting matrix is chosen as an approximation to the matrix 

W» = [e {aIi, - AG^oXAh, - AG, Uo ) t jj . Since the statistical properties of the 

solution given by Equation (4) are relatively insensitive to small variations in the choice 
of the weighting matrix, we will make the simplifying assumption that Wj = W 0 
throughout the remainder of the statistical analysis. In practice, the matrix Wj is an 
estimate of W 0 based on the observed data, but the error in the derived statistical 
properties introduced by this assumption is insignificant in comparison to the other 
simplifying assumptions made in the analysis. 

Letting Uj = u 0 + Auj , Equation (4) gives 

(g 0 + AgJ W, (G 0 + AG)(u 0 + A Ul )= (G 0 + AG J Vf x (h 0 + Ah). 

This expression can be solved for an approximation to Auj by expanding, simplifying, 
and dropping terms involving powers of the vector 5 greater than two. Proceeding in this 
manner and recalling that G 0 u 0 = h 0 and Wj = W 0 , we get 


Auj = [g£w 0 G 0 + AG[ W 0 G 0 + gJWqAGj + ag[ WoAg ,] -1 
•(G 0 + AG 1 ) r W 0 (Ah 1 -AG 1 u 0 ) 

* (gJw„G 0 )' (G 0 + AG,/ W 0 (All, - AG,u 0 ) 

- (gJWoGo ) 1 (ag(w 0 g„ + gJw 0 ag,)(gJw 0 g 0 J' Gjw„ (Ah, - AG,u 0 ). 


Using this result, and assuming that E {5} = 0 , we see that an approximation for the bias 
in Stage 1 of the algorithm is given by 


( 1 , =£{Au,} 


*c 2 (gJw 0 g 0 )"‘gJwo 
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4 Q(R + r 0 l)W 0 G 0 (gJw 0 G 0 j‘ 


(5) 


- 4c 2 Tr W, 


Go (gJw o G 0 J' Gjw„ - 1 (R + r 0 l)Qj (gJw 0 G 0 


0 

0 

1 


2-8 



where = E ^ j, <s\ =E ^2 •••> = E j- Proceeding in a similar fashion, 

and recalling that W 0 = -^Ah! - AGjUQ^Ah, - AGjUq) jj , we can derive an 

approximation for the autocorrelation matrix of Auj . In particular, we get 

E £u,Auf }= (gJw 0 G 0 )~'gJw 0 £ |ai., - AG^XAh, - AG,u„/ ] 


•w 0 g 0 (gJw 0 g 0 J‘ 

= (G 0 r W 0 G 0 J'. 


(S) 


Note that this implies that the approximation for the covariance matrix of Auj takes the 
form 


El^GjWoGoJ'-n^f, 

which is slightly different than the result presented in [4], where the bias of the estimate 
was ignored. Finally, it is straightforward to show that 


w„ =[e |Ah, - AG.UoXAJi, - AG,u o y =^_(B 1 QB 1 )-‘, (7) 

where Bj = R + r 0 I . Equations (5) and (6) with W 0 given by Equation (7) constitute the 
desired statistical properties for Stage 1 of the algorithm. 

For the second stage of the algorithm, the possible inconsistency between the estimated 
values for (x 0 ,y 0 ) and r 0 = <Jxq + yl obtained in the vector u, is resolved by computing 
a new estimate of (4 ,^o J based on fij . The approach is again weighted least squares, 
and we begin by defining 


g 2 = 

*1 o' 
0 1 

, h 2 = Uj 0Uj = 

1 

, Ah 2 = h 2 - u 0 ou 0 = h 2 - G 2 

1 

cso C' 
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( M 3 )) 2 
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Clearly, the equation 


g 2 



= u 0 


ou 0 


is always satisfied, while the associated equation 
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(ui (1 yf 

Q v v = h 2 ( 8 ) 

% m 

will not generally be satisfied. The estimate u 2 of (x^,yl J is computed as a weighted 
least squares solution to Equation (8) given by 

u 2 = (G^W 2 G 2 )' 1 G[w 2 h 2 , 

where W 2 is an estimate of the inverse of the autocorrelation matrix E ^Ah 2 Ah 2 j. 
Assuming that the error Auj in the Stage 1 estimate u { is small, we have 

Ah 2 « 2B 2 Au, , 

where B 2 = diag(x 0 ,y 0 ,r 0 ), and it follows from Equation (6) that 

E -jAh 2 Ah 2 j* 4B 2 £ {AujAuf ]b 2 « 4B 2 (gJw 0 G 0 J 1 B 2 . 

Again, the statistical properties of the estimate u 2 are insensitive to small variations in 

W 2 , so we simply assume for the remaining analysis that W 2 1 = 4B 2 (gJw 0 G 0 ^ B 2 . 
Finally, letting 

\ x l 

»2 = ° + Au 2 , 

To. 

it follows that 


Au 2 = u 2 


(G 2 W 2 G 2 ) G 2 W 2 h 2 - 


= (g£w 2 g 2 y G 2 W 2 h 2 - (g£w 2 g 2 J 1 g 2 w 2 g 2 x ° 2 

LTo . 

= (g[w 2 g 2 )'gJw 2 h 2 -G 2 x ° = (g 2 \v 2 g 2 j 1 g; W,A h, 

\ boJJ 

« 2(g£w 2 G 2 J 1 G 2 W 2 B 2 Auj 
* 2(g^B 2 1 gJw 0 G 0 B 2 1 G 2 y gJb^gJWoGoAuj. 


Hence, 
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= E {Au 2 } 

- 2(gJb 2 1 gJw 0 G 0 B 2 1 G 2 J* G^B^GfWoGo^ {A Ul } 


2 C 2 (g£b 2 1 gJw 0 G 0 B; 1 G 2 )~' 

r rro?i 


G ^ 1 


G Jw 0 + 4 qb 1 w 0 g 0 (gJw 0 g 0 J 1 0 


, x . 0 
-4Tr[w 0 G 0 (gJw 0 G 0 J 1 gJw 0 -I BjQJ 0 


^ 2 =E -jAu 2 Au 2 1 

«(g[w 2 g 2 J 1 g[w 2 £ <^h 2 Ah 2 r }w 2 g 2 (g£w 2 g 2 J 


(g£w 2 g 2 


= 4(( 


g 2 b 2 ‘Gq w 0 g 0 b 2 1 g 2 


Equations (9) and (10) constitute the desired statistical properties for Stage 2 of the 
algorithm. 

For the third and final stage of the algorithm, the estimated values of (x^,yl 1 obtained in 

the vector u 2 are used to obtain a final estimate of (.r 0 ,y 0 ) based on u 2 and Uj 
combined. The final estimate u 3 of (vo>fo) is given by 

u 3 = , 

where, in this case, indicates a component- wise square-root operation and 

P = diag(sgn[u,(l)],sgn[u 1 (2)]^). Assuming that the sign of each coordinate in Uj is 
correct, it follows that 
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Au 3 = u 3 - 

» BJ 1 (g^gJWdGoB^Gj J‘ GjBi l GjW 0 G c Au„ 

where B 3 = diag{jc 0 ,^ 0 }. Hence, the final approximations for the bias vector and 
autocorrelation matrix of the algorithm are given by 



H3 = E { Au 3 } 

* t B; 1 (G^Bi'GjWoGoBi'G;, )' GjB^Go W 0 G 0 £ {A Ul } 

» ^bj 1 (gJb5 1 g5'w 0 g 0 bj‘g 2 J 1 g^Bj 1 



= c 2 BJ 1 (G^Bj'GjBr'Q-'Br'GoBj'Gj)' Gfo 1 



( 11 ) 


and 


2-12 



S 3 = £ -jAujAuj 

. .. ( 12 ) 

»4c 2 BJ l (G[B; 1 GfW 0 G 0 BJ 1 G 2 ) BJ 1 

= 4c 2 Bi' (G^Bj'GjBJ-'Q-'Br'GoBi'Gj J'Bj 1 . 

The proposed modifications to this algorithm are discussed in the following and final 
section of this report. 


Proposed Algorithm Modification 


In an effort to improve the localization and tracking performance, we propose a simple 
modification to Stage 1 of the algorithm described above. We consider a Stage 1 estimate 
based upon a weighted total-least-squares solution instead of the weighted least-squares 
solution currently used. 1 In order to describe the proposed new Stage 1 algorithm, we let 
G 0 , Gj , h 0 , and hj be defined as above, but we change the definition of AG] just 
slightly. In particular, we let 


AG, = 


-2 • 


S 11 8 12 C $1 

e 21 s 22 c §2 

M M M 

Z M\ 8 M2 c §M 


where -je^ :i,j = 1,2,K M j are independent, identically distributed random variables 
with mean zero and variance c>l , where al « min -^j] ,c> 2 ,K ,o 2 M j. This is merely a 
device for making AG] full rank with probability one while still reflecting the fact that 
the positions of the sensors {(•%yi),(* 2 s>’ 2 )>K are much more precisely 

known than the measured TDOA values. 


With this change in mind, we now define the new matrices G 0 = [G 0 | h 0 ], 
G] = [G] | hj] and A, = [AG] | Ah]]. Note that Equation (2) can now be rewritten as 


and Equation (3) can be rewritten as 


1 For discussions of both total-least-squares solutions and least-squares solutions, see for example [11], 
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Now, let E L = E Aj j and E R = E ^Aj Af j. Then it is straightforward to show that 


E R * 8a 2 I + 4c 2 [Q + RQR - QR - RQ]+ 2c 4 Q oQ + c A 


and 


4 Mu z E 0 

0 4 Mai 


0 

0 


0 2 2 

M 

a A i 


0 

0 


r 2 2 I 2 1 

a l °2 L CT W J, 


0 0 4c 2 TrQ -4c 2 Tr(RQ) 

0 0 -4c 2 Tr(RQ) c 2 Tr(2RQR+ 3 c 2 Qoq)J 

We seek a matrix A and an estimate u t of u 0 such that the equation 

-ri” 1 




= 0 


(13) 


is satisfied, and the matrix A has minimum possible norm of the form 

||A| = ^Tr(A 7 '2R 1 A2L') 


To find Uj and A , we first factor E L and E R using the Cholesky decomposition to get 
E R = W L W L r and E R = W R W R and note that Equation (13) can be rewritten as 


or equivalently 


where 


w i (g, - a)w l w i : 1 


V 

-1 


= o , 



(14) 
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g = w£g,w l , 
Wp aw l , 


at wf 1 


A — 
^1 

-1 • 


Now to solve Equation (13), we look first for A and u that satisfy Equation (14) such 
that A has minimum possible Froebinius norm, which is given by 

The desired solution for Equation (14), which is well known [1 1], is derived as follows. 
Let the singular value decomposition of G be given by 

G = UDV r , 

where the columns of V are the orthonormal eigenvectors of G T &. Let v min be the 

column of V corresponding to the smallest eigenvalue X min of G T & C . The desired 
solution to Equation (14) is given by 

^ — V^min^ min^min > ^^min ’ 

where a is chosen such that 


u = av r 


= w L - ] 


-i 


or equivalently, 


-i 


CtWLV m j n . 


Hence, a is the negative of the inverse of the last component of the vector W L v min , and 
the vector u { is the desired Stage 1 solution to Equation (13). Stage 2 and Stage 3 of the 
new algorithm are identical to the original Stage 2 and Stage 3. 


References 


[1] "PulsON Technology Overview," 

http://www.timedomain.com/Files/dowtiloads/techpapers/PulsONOverview7 0 1 .pdf . 

[2] J. C. Adams, W. Gregorwich, L. Capots, and D. Liccardo, "Ultra-Wideband for Navigation 
and Communications," Proceedings of IEEE Aerospace Conference, 2001. 

[3] C. W. Borst, "Telerobotic Ground Control of a Space Free Flyer," Proceedings of IEEE/RSJ 
International Conference on Intelligent Robots and Systems, 1998. 


2-15 



[4] Y. T. Chan and K. C. Ho, "An Efficient Closed-Form Localization Solution From Time 
Difference of Arrival Measurements," 1994. 

[5] H. Choset, et al., "Path Planning and Control for AERCam, a Free-Flying Inspection Robot 
in Space," Proceedings of IEEE International Conference on Robotics and Automation, 
1999. 

[6] FCC, "First Notice and Order: Revision of Part 15 of the Commission's Rules Regarding 
Ultra-Wideband Transmission Systems," Feb. 2002. 

[7] M. G. M. Hussain, "Principles of Space-Time Array Processing for Ultrawide Band Impulse 
Radar and Radio Communications," IEEE Transactions on Vehicular Technology, vol. 51, 
pp. 393-403, 2002. 

[8] D. Kortenkamp, et al., "Applying a Layered Control Architecture to a Free-Flying Space 
Camera," Proceedings of IEEE International Joint Symposium on Intelligence and Systems, 
1998. 

[9] Y. C. Loh, et al., "Wireless Video System for Extra Vehicular Activity in the International 
Space Station and Space Shuttle Orbiter Environment," Proceedings of IEEE 49th Vehicular 
Technology Conference, 1999. 

[10] K. Siwiak, et al., "Advances in Ultra-Wide Band Technology," Proceedings of Radio 
Solutions 2001, Commonwealth Conference & Events Centre, London, 2001. 

[11] C. W. Therrien, Discrete Random Signals and Statistical Signal Processing. Englewood 
Cliffs, NJ: Prentice-Hall, 1992. 


2-16 



Appendix 

In this Appendix, we derive the bias and mean-squared-error (MSE) for the current 
weighted-least-squares TDOA algorithm for a simple far-fteld example. In particular, we 

let M = 4 , Q = a 2 I , and r 0 » max (max }). Then, from Equation (1 1), we 

1<i<4 ^ ^ 


get 


H 3 = cVb^G^'gJb^GoB^Gj J' G^B , 1 
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Continuing to simplify this, we get 


bA = 


b;'gJ = — !— 
Wl 
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Wo 0 
0 r 0 x 0 
0 0 
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x oyo. 


r o x oyo 
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g^b^gJ = — ! — 
nwo 

+x 0 cd l ) y 0 (r Q x 2 +x 0 cd 2 ) y 0 (r 0 x 3 +x 0 cd 3 ) y 0 (r 0 x 4 + x 0 cd 4 ) 
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f x 0 /) y 0 A ■AT jc 0 V y 0 

zy + y di ) ly ,+ r» cd ‘) -Ijij^v o{ yi+ y d o\ 

— zfj'i + ‘iWj - — E(V: + V rf /)(Wi *yi, al ,) 

r O j^l V f 0 ) r O i= 1 

— Z U- + ~ c 4-] - — Z ( r o x / + wdi Xw + yo cd i ) 

_ r 0 /=1 V r O / r O ,=1 

Now, let * 0 = r 0 cos0 , y 0 = r 0 sin0 , 

x = [x l +cd l cosQ x 2 +cd 2 cosB x 3 + cy^ cos0 x 4 +cd 4 cosOjZ 
$a= [y t + cd x sin 0 y 2 +cd 2 sin 0 y 3 + cd^ sm0 y 4 + cd 4 sin 0 j 2 " , 
(W=M^|cos(t). 

Then, putting this all together, it follows that the bias vector for this example is given by 


s j*\ 1ST 

, 2 «? - ( m 2 1** 2 


8 c 2 o 2 r 0 m$ +1^| 2 


cosG -(:&£$^sin0 
sm0-(#^cos0 
|$jj> 2 cos0-($£$ism0 

m 2 +m 2 


(j- cos 2 <))^ ||&f 2 sin0-($£>;$cos0 

m 2 +m 2 


Similarly, Equation (12) gives 
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Z 3 = 4CVB3 1 (gI B2 I gJb]' 2 G 0 B2 1 G 2 ) B3 1 

« 4c 2 CT 2 r 0 2 B 3 1 (gJb^gJGqB^GsJ 1 B 
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M 
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Hence, the total MSE is given by 


2 +iim 2 i» 2 +r 2 


,2„2„2 |ffl2 


4c c 7 0 

MSE = Tr(Z 3 )= —x — ■= 

v Ilnn2||n>|2 


3 


^-COS 2 (()^ 


which completes the example. 
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